#waypoint_follower_msgs/WaypointStamped[] waypoints
geometry_msgs/PoseStamped[] waypoints
